Parallel robot provided with wrist section having three degrees of freedom

ABSTRACT

A parallel robot includes a movable-section drive mechanism, and a wrist-section drive mechanism. The wrist section includes a first rotary member supported on the movable section and rotatable about a fourth rotation axis different from axes of the three-axis translational motion of the movable section, a second rotary member connected to the first rotary member and rotatable about a fifth rotation axis orthogonal to the fourth rotation axis, and a third rotary member connected to the second rotary member and rotatable about a sixth rotation axis orthogonal to the fifth rotation axis. The third rotary member is provided with an attachment surface to which a tool is attached. The attachment surface is inclined with respect to the sixth rotation axis at a predetermined angle.

CROSS REFERENCE TO RELATED APPLICATION

This application is a continuation-in-part application of Ser. No.12/704,027 filed on Feb. 11, 2010, which claims priority to JapaneseApplication No. 2009-030876 filed Feb. 13, 2009, the disclosures ofwhich are incorporated by reference herein in their entirety.

BACKGROUND OF THE INVENTION

1. Field of the Invention

The present invention relates to a parallel robot provided with a wristsection having three degrees of freedom.

2. Description of the Related Art

Various types of parallel robots, in which a plurality of actuators(e.g., servo-motors) are attached to a stationary member acting as abase section and links joined to the output parts of the actuators arerespectively driven so as to control the position and orientation of amovable section attached to the distal end of each link, have been knownin the art. A parallel robot has a configuration in which the basesection is connected to a movable section by a plurality ofassembled-link structures arranged in parallel, and thereby hascharacteristics, such as high accuracy, high stiffness, high speed, highoutput, etc. Because of these characteristics, a parallel robot may beused as a robot for high speed handling or assembling.

FIG. 11 illustrates the parallel robot described in Japanese ExaminedPatent Publication (kokai) No. 4-45310 (JP4-45310B). The illustratedparallel robot has a configuration referred to as a delta-type, andincludes a single base member 200 and a single movable member 208.

The base member 200 is provided with three rotary actuators 213. Each ofthe rotary actuators 213 includes a single stationary portion 203 formedintegrally with the base member 200. The rotary shafts 202 of the threerotary actuators 213 are disposed in an identical plane. Each of threedriving links 204 is fixedly attached at one end 215 thereof to eachrotary shaft 202. The other end 216 of each driving link 204 is joinedto two driven links 205 a, 205 b through two Cardan-type double joints206 a, 206 b.

The two driven links 205 a, 205 b in each assembled-link structure arejoined to the movable member 208 through two Cardan-type double joints207 a, 207 b. As a result, it is possible to control the motion of themovable member 208 while controlling the operation of the driving links204, so as to allow the movable member 208 to perform a three-axistranslational motion. A working member (hereinafter referred to as atool) such as a hand 209, etc., may be mounted on the movable member208.

An orientation changing axis (referred to as a fourth axis) 200A forchanging the orientation of the tool, such as the hand 209, etc., is setin the movable member 208 so as to extend orthogonally to the majorsurface of the movable member 208. The tool, such as the hand 209, etc.,is driven for rotation through a telescopic arm 214 by a rotary motor211 mounted on the base member 200. The three actuators 213 and therotary motor 211 are controlled by a controller 212.

The parallel robot disclosed in JP4-45310B is provided with theorientation changing axis 200A, referred to as the fourth axis, forchanging the orientation of the tool, such as the hand 209, etc.,disposed on the movable member 208. However, it is difficult to performa task for mounting a workpiece to an inclined surface only by a singleorientation changing axis (i.e., the fourth axis).

SUMMARY OF THE INVENTION

The present invention provides, as one aspect, a parallel robot havingan increased number of degrees of freedom, which can prevent theoccurrence of a singular state where a robot movement for disposing atool mounted on a movable section at a target position and orientationcannot be unambiguously programmed.

One aspect of the present invention provides a parallel robot comprisinga base section; a movable section capable of moving with respect to thebase section; a movable-section drive mechanism having a parallelmechanism configuration and provided between the base section and themovable section, the movable-section drive mechanism operating to allowthe movable section to perform a three-axis translational motion withrespect to the base section; a wrist section provided in the movablesection in a manner capable of changing an orientation of the wristsection; and a wrist-section drive mechanism operating to allow thewrist section to perform a three-axis orientation-changing motion withrespect to the movable section. The wrist section comprises a firstrotary member supported on the movable section and rotatable about afourth rotation axis different from axes of the three-axis translationalmotion of the movable section; a second rotary member connected to thefirst rotary member and rotatable about a fifth rotation axis orthogonalto the fourth rotation axis; and a third rotary member connected to thesecond rotary member and rotatable about a sixth rotation axisorthogonal to the fifth rotation axis. The third rotary member isprovided with an attachment surface to which a tool is attached. Theattachment surface is inclined with respect to the sixth rotation axisat a predetermined angle.

Another aspect of the present invention provides a parallel robotcomprising a base section; a movable section capable of moving withrespect to the base section; a movable-section drive mechanism having aparallel mechanism configuration and provided between the base sectionand the movable section, the movable-section drive mechanism operatingto allow the movable section to perform a three-axis translationalmotion with respect to the base section; a wrist section provided in themovable section in a manner capable of changing an orientation of thewrist section; and a wrist-section drive mechanism operating to allowthe wrist section to perform a three-axis orientation-changing motionwith respect to the movable section. The wrist section comprises a firstrotary member supported on the movable section and rotatable about afourth rotation axis different from axes of the three-axis translationalmotion of the movable section; a second rotary member connected to thefirst rotary member and rotatable about a fifth rotation axis orthogonalto the fourth rotation axis; a third rotary member connected to thesecond rotary member and rotatable about a sixth rotation axisorthogonal to the fifth rotation axis; and a first input shaft member, asecond input shaft member and a third input shaft member, rotatablysupported on the movable section and connected respectively to the firstrotary member, the second rotary member and the third rotary memberthrough gears. The wrist-section drive mechanism comprises a firstservo-motor, a second servo-motor and a third servo-motor, which arecarried on the base section and respectively generate driving force todrive the wrist section for rotation; and a first transmission member, asecond transmission member and a third transmission member, transmittingthe driving force of the first servo-motor, the second servo-motor andthe third servo-motor, respectively to the first input shaft member, thesecond input shaft member and the third input shaft member. The firstservo-motor, the second servo-motor and the third servo-motorrespectively drive the first rotary member, the second rotary member andthe third rotary member for rotation.

BRIEF DESCRIPTION OF THE DRAWINGS

The objects, features and advantages of the present invention willbecome more apparent from the following description of the preferredembodiments in connection with the accompanying drawings, wherein:

FIG. 1 is a perspective view of a parallel robot including a wristsection having three degrees of freedom;

FIG. 2 is a schematic vertical sectional view of a part of the parallelrobot of FIG. 1;

FIG. 3 is an enlarged perspective view depicting a movable section andthe wrist section of the parallel robot of FIG. 1;

FIG. 4 is a front view of the wrist section of the parallel robot ofFIG. 1;

FIG. 5 is a front view of a wrist section of a parallel robot accordingto an embodiment of the present invention;

FIG. 6 is a perspective view of a parallel robot according to anembodiment of the present invention;

FIGS. 7A and 7B are illustrations explaining a state where a hand isattached to the wrist section of FIG. 5;

FIGS. 8A and 8B are illustrations explaining a structure of the wristsection of FIG. 5, in which FIG. 8B is a sectional view taken along aline VIII-VIII of FIG. 8A;

FIGS. 9A and 9B are enlarged sectional views of a major portion of awrist-section drive mechanism of the parallel robot of FIG. 6, whereinFIG. 9A is a vertical sectional view depicting a holder assembly andFIG. 9B is another vertical sectional view depicting the holderassembly;

FIG. 10 is an enlarged view of the major portion of the wrist-sectiondrive mechanism of FIG. 9A;

FIG. 11 is a schematic perspective view of a conventional parallelrobot; and

FIG. 12 is a schematic illustration depicting a parallel robot accordingto an embodiment of the present invention, which includes the wristsection shown in FIG. 4 or 5.

DETAILED DESCRIPTION

The embodiments of the present invention are described below, in detail,with reference to the accompanying drawings. In the drawings, same orsimilar components are denoted by common reference numerals.

Referring to the drawings, FIGS. 1 to 4 schematically depict aconfiguration of a parallel robot PR provided with a wrist sectionhaving three degrees of freedom, which is described in anotherapplication prior to the present application. The parallel robot PRincludes a base section 12; a movable section 100 capable of moving withrespect to the base section 12; a movable-section drive mechanism 16having a parallel mechanism configuration and provided between the basesection 12 and the movable section 100, the movable-section drivemechanism 16 operating to allow the movable section 100 to perform athree-axis translational motion with respect to the base section 12; awrist section 102′ provided in the movable section 100 in a mannercapable of changing the orientation of the wrist section; and awrist-section drive mechanism 20 operating to allow the wrist section102′ to perform a three-axis orientation-changing motion with respect tothe movable section 100. The parallel robot PR is configured so that themovable section 100 performs only the three-axis translational motionwith respect to the base section 12 (in other words, the parallel robotPR is provided with a parallel mechanism having three degrees offreedom).

The base section 12 is formed of a plate-like structure fixedly providedin a laterally and horizontally projecting manner at the top of anarcuate standing wall 22 placed on a mounting surface for the parallelrobot PR. The base section 12 is configured as a stationary member forcarrying several components of the movable-section drive mechanism 16and the wrist-section drive mechanism 20 described below. A cover 24 issecurely and removably attached to the upper side of the base section 12to cover drive motors, power transmission mechanisms, etc.

The movable-section drive mechanism 16 includes three assembled-linkstructures 26 arranged in parallel, and three servo-motors 28 (only onemotor is depicted in FIG. 2) for respectively driving the assembled-linkstructures 26. Each assembled-link structure 26 includes a driving link30 articulately connected to the base section 12 and the output part ofa corresponding servo-motor 28 through a plurality of revolute pairs (orhinge joints) and an auxiliary link, and a parallel pair of driven links32 articulately connected to the distal end of the driving link 30through a revolute pair. The parallel driven links 32 are articulatelyconnected at the distal ends thereof to the movable section 100 througha revolute pair. More specifically, universal joints (each including,e.g., a set of revolute pairs) are provided between the driving link 30and the driven links 32, and also between the driven links 32 and themovable section 100.

The driving link 30 is driven by the servo-motor 28 so as to variouslyswing along a virtual plane extending vertically to the base section 12.The parallel driven links 32 are displaced while accompanying the swingmotion of the driving links 30. In this connection, the parallel drivenlinks 32 of one assembled-link structure 26 are connected to theparallel driven links 32 of the other two assembled-link structures 26through the movable section 100, so that the respective parallel drivenlinks 32 of the three assembled-link structures 26 are variously andpassively swung, depending on the swinging mode of the three drivinglinks 30.

The three assembled-link structures 26 have a configuration wherein therespective driving links 30 are connected to the base section 12 atthree fixed positions spaced apart from each other by a central angle ofevery 120 degrees on the base section 12, and the respective drivenlinks 32 are connected to the movable section 100 at three fixedpositions spaced apart from each other by a central angle of every 120degrees on the movable section 100. As a result, in response to theoperation of the movable-section drive mechanism 16, the movable section100 performs only the three-axis translational motion with respect tothe base section 12.

Three wrist-section drive mechanisms 20 are provided respectively forthree control axes for allowing the wrist section 102′ to perform theorientation-changing motion (only one wrist-section drive mechanism isdepicted in FIG. 2). Each of the wrist-section drive mechanisms 20 isconfigured as an auxiliary drive mechanism for controlling theorientation of a tool, such as a hand, etc., attached to the wristsection 102′ and mounted on the movable section 100. The wrist-sectiondrive mechanism 20 includes a holder assembly 50 configured byassembling three hollow cylindrical holders 44, 46 and 48 in a mannerrotatable with respect to each other to form a triply nested structure,a servo-motor (not depicted) driving an outer holder 44 of the holderassembly 50 for rotation, and a rod-shaped transmission member 54linearly movably received in an inner holder 48 of the holder assembly50. The base section 12 is provided with a hollow cylindrical seatportion 56 formed to project toward the cover 24. The outer holder 44 ofthe holder assembly 50 is attached to the seat portion 56 through arotational bearing unit.

FIGS. 3 and 4 depict the movable section 100 and wrist section 102′ ofthe parallel robot PR. The movable section 100 is formed of acylindrical member having a cavity part (not depicted), and is providedat three positions on the outer circumference thereof with joint parts104, to which the parallel driven links 32 of the three assembled-linkstructures 26 of the movable-section drive mechanism 16 are respectivelyconnected. Rotational bearing units and power transmission mechanisms(not depicted) are accommodated in the cavity of the movable section100. The wrist section 102′ is supported rotatably on the bottom side(in the drawing) of the movable section 100.

The wrist section 102′ includes a first rotary member 106 supported onthe movable section 100 and rotatable about a fourth rotation axis 106 adifferent from the control axes of the three-axis translational motionof the movable section 100, a second rotary member 108 connected to thefirst rotary member 106 and rotatable about a fifth rotation axis 108 aorthogonal to the fourth rotation axis 106 a, and a third rotary member110 connected to the second rotary member 108 and rotatable about asixth rotation axis 110 a orthogonal to the fifth rotation axis 108 a.The third rotary member 110 is provided with an attachment surface 112to which a tool or end effector, such as a hand, etc., (not depicted) isattached. The attachment surface 112 is a substantially flat surfaceformed orthogonal to the sixth rotation axis 110 a.

A first one of the three wrist driving mechanisms 20 that allow thewrist section 102′ to perform the three-axis orientation-changingmotion, includes a first transmission member 54-1 connected to the firstrotary member 106 through a first universal joint 80-1 and powertransmission elements such as gear trains (not depicted). The firsttransmission member 54-1 operates to transmit a rotation of a firstouter holder 44 driven for rotation by a first servo-motor to the firstrotary member 106, and to allow the first rotary member 106 to perform arotational motion about the fourth rotation axis 106 a.

A second one of the three wrist-section drive mechanisms 20 includes asecond transmission member 54-2 connected to the second rotary member108 through a second universal joint 80-2 and power transmissionelements such as gear trains (not depicted). The second transmissionmember 54-2 operates to transmit a rotation of a second outer holder 44driven for rotation by a second servo-motor to the second rotary member108, and to allow the second rotary member 108 to perform a rotationalmotion about the fifth rotation axis 108 a.

A third one of the three wrist-section drive mechanisms 20 includes athird transmission member 54-3 connected to the third rotary member 110through a third universal joint 80-3 and power transmission elementssuch as gear trains (not depicted). The third transmission member 54-3operates to transmit a rotation of a third outer holder 44 driven forrotation by a third servo-motor to the third rotary member 110, and toallow the third rotary member 110 to perform a rotational motion aboutthe sixth rotation axis 110 a.

In the parallel robot PR including the wrist section 102′ having threedegrees of freedom, it is possible to allow a tool (not depicted)attached to the attachment surface 112 of the wrist section 102′ toperform the three-axis translational motion and the three-axisrotational motion in an appropriately combined manner. As a result, theparallel robot PR can perform various tasks, such as a task for mountinga workpiece onto an inclined surface.

In the parallel robot PR including the wrist section 102′ depicted inFIGS. 3 and 4, the wrist section 102′ is relatively frequentlycontrolled to be arranged at an orientation in which the fourth rotationaxis 106 a and the sixth rotation axis 110 a are parallel to each other(in a case where the parallel robot PR is situated on a floor, anorientation in which both the fourth rotation axis 106 a and the sixthrotation axis 110 a are vertical to a floor surface and the attachmentsurface 112 is horizontal with respect to the floor surface), in orderto perform a task such that, for example, the hand attached to theattachment surface 112 of the wrist section 102′ is operated to grip orrelease a workpiece placed on a pallet or conveyor. In a state where thefourth rotation axis 106 a and sixth rotation axis 110 a in the wristsection 102′ are parallel to each other, a rotational position of theattachment surface 112 with respect to the movable section 100 isdetermined by a combination of a rotational position of the fourthrotation axis 106 a and a rotational position of the sixth rotation axis110 a, while, on the other hand, a rotational orientation of theattachment surface 112 with respect to the movable section 100 ismaintained constant regardless of the rotational positions of the fourthrotation axis 106 a and sixth rotation axis 110 a (in a case where theparallel robot PR is situated on a floor, the attachment surface 112 isoriented horizontally with respect to a floor surface). Therefore, suchstate is regarded as a singular state (hereinafter referred to as asingularity), in which a robot movement (i.e., a solution fordetermining the position and orientation of a robot) for disposing atool mounted on the movable section 100 at a target position andorientation cannot be unambiguously programmed or determined.

In contrast, in a wrist section 102 depicted in FIG. 5, which is onecomponent of a parallel robot according to an embodiment of the presentinvention, a third rotary member 110 is provided with an attachmentsurface 114 inclined with respect to a sixth rotation axis 110 a at apredetermined angle as depicted (in the drawing, an axial line 112 aorthogonal to the attachment surface 114 defines a predetermined angle αwith respect to the sixth rotation axis 110 a). According to the aboveconfiguration, in a state where a fourth rotation axis 106 a and thesixth rotation axis 110 a are parallel to each other (i.e., in asingularity), the attachment surface 114 is inclined with respect to therotation axes 106 a, 110 a as depicted. On the other hand, when theattachment surface 114 is disposed at the aforementioned orientationadapted to be relatively frequently taken (in a case where the parallelrobot is situated on a floor, the orientation in which the attachmentsurface 114 is horizontal with respect to a floor surface), it ispossible to prevent a situation (or a singularity) in which the fourthrotation axis 106 a and the sixth rotation axis 110 a are arrangedparallel to each other from occurring, as described later. In thisconnection, it is preferable that the depicted predetermined angle α is,for example, at least 30 degrees and at most 60 degrees, in a casewhere, for example, a hand 122 (FIG. 7A) is attached to the attachmentsurface 114 and is operated to perform tasks.

As described above, due to a simple configuration in which the thirdrotary member 110 is provided with the attachment surface 114 inclinedwith respect to the sixth rotation axis 110 a at a predetermined angle,it is possible to prevent the state of the wrist section 102 fromreaching the singularity when the attachment surface 114 is disposed atthe relatively frequently-arranged orientation (in the case where theparallel robot is situated on the floor, the orientation in which theattachment surface 114 is horizontal with respect to the floor surface).Consequently, it is possible to actualize the wrist section 102 havingan inexpensive and compact structure and having control axes therespective operations of which are easily understandable. Therefore, itis possible to greatly improve the usability of the parallel robot.Further, it is not necessary for the tool, such as the hand, to take anymeasures for avoiding the singularity, such as providing the tool with apredetermined inclination angle. Therefore, it is possible to easily andinexpensively manufacture the tool.

FIG. 6 schematically depicts an overall configuration of a parallelrobot 10 according to an embodiment of the present invention andincluding the wrist section 102. The parallel robot 10 has aconfiguration substantially identical to that of the parallel robot PRdepicted in FIGS. 1 to 4, except for the configuration of the wristsection 102, and thus corresponding components are denoted by the samereference numerals and the descriptions thereof are not repeated. In theparallel robot 10, a hand 122 (see FIGS. 7A and 7B) for performing taskssuch as gripping and transferring a workpiece (not depicted) can beattached to the attachment surface 114 of the wrist section 102. In thiscase, an attachment part 120 provided in the hand 122 is fitted to theattachment surface 114.

For example, in a system configuration in which the parallel robot 10 issituated on a floor, when a workpiece placed on a workpiece-supportsurface of a pallet or conveyor, which extends horizontally with respectto the floor surface, should be gripped, it is generally performed toorient a fingertip of the hand 122 immediately beneath. In the parallelrobot 10 including the wrist section 102, in order to locate theattachment surface 114 horizontally with respect to the floor surfaceand thus to orient the fingertip of the hand 122 immediately below, anoperation is performed, in which, starting from a state where the fourthrotation axis 106 a and the sixth rotation axis 110 a are parallel toeach other (FIG. 5), a fifth rotation axis 108 a is rotated by apredetermined angle (corresponding to the aforementioned predeterminedangle α) and the sixth rotation axis 110 a is rotated by a predeterminedangle (FIGS. 7A and 7B). As a result, in the state where the fingertipof the hand 122 is oriented immediately below, the fourth rotation axis106 a and the sixth rotation axis 110 a are not parallel to each other,and it is thus possible to prevent the state of the wrist section 102from falling into the singularity.

Referring to FIGS. 8A and 8B, the structure of the wrist section 102 isdescribed in more detail. As already described with reference to FIG. 3,a driving force for driving the wrist section 102 for rotation istransmitted from the servo-motors 52 of mutually-independent threewrist-section drive mechanisms 20 to the wrist section 102 through thetransmission members 54-1, 54-2, 54-3 of the respective wrist-sectiondrive mechanisms 20. The wrist section 102 includes three input shaftmembers 101 rotatably supported on a cylindrical movable section 100through rotational bearing units. All of the input shaft members 101 areadapted to rotate about axial lines parallel to the fourth rotation axis106 a. The driving force for rotating the wrist section 102 aretransmitted from the transmission members 54-1, 54-2, 54-3 of the threewrist-section drive mechanisms 20 to the three input shaft members 101through universal joints 80-1, 80-2, 80-3, respectively.

Gears 4-1, 5-1, 6-1 are respectively secured to the distal ends of theinput shaft members 101 (gears 5-1 and 6-1 are not depicted). Ahollow-tubular first driven gear 4-2 is fixed to a first rotary member106. The first driven gear 4-2 (and thus the first rotary member 106) iscoupled or geared to a first one of the input shaft members 101, androtatably supported on the movable section 100 through a rotationalbearing unit. The gear 4-1 is engaged with the first driven gear 4-2 andthereby a rotational driving force transmitted to the gear 4-1 of thefirst input shaft member 101 is in turn transmitted to the first drivengear 4-2, so that the first rotary member 106 is operated to rotateabout the fourth rotation axis 106 a.

Inside the first driven gear 4-2 of the first rotary member 106, twohollow-tubular gears 5-2, 5-3 are rotatably supported through rotationalbearing units. The gears 5-2, 5-3 are integrally fixed to each other sothat a driving force can be transmitted therebetween, and therebyconstitute a first intermediate gear. A hollow-tubular second drivengear 5-4 is fixed to a second rotary member 108. The second driven gear5-4 (and thus the second rotary member 108) is coupled or geared to asecond one of the input shaft members 101 through the first intermediategear (i.e., the gears 5-2, 5-3), and rotatably supported on the firstrotary member 106 through a rotational bearing unit. A rotationaldriving force transmitted to the gear 5-1 (not depicted) of the secondinput shaft member 101 is in turn transmitted to the second driven gear5-4 through the first intermediate gear (i.e., the gears 5-2, 5-3), sothat the second rotary member 108 is operated to rotate about the fifthrotation axis 108 a.

Inside the first intermediate gear (i.e., the gears 5-2, 5-3), a secondintermediate gear 6-3 including a shaft part with a gear 6-2 secured tothe end of the shaft part is rotatably supported through a rotationalbearing unit. Inside the second driven gear 5-4, a third intermediategear 6-4 including a shaft part with a gear 6-5 secured to the end ofthe shaft part is rotatably supported through a rotational bearing unit.A third driven gear 6-6 is fixed to the third rotary member 110. Thethird driven gear 6-6 (and thus the third rotary member 110) is coupledor geared to a third one of the input shaft members 101 through thesecond intermediate gear 6-3 and the third intermediate gear 6-4. Thethird rotary member 110 and the third driven gear 6-6 are rotatablysupported on the second rotary member 108 through a rotational bearingunit. A rotational driving force transmitted to the gear 6-1 (notdepicted) of the third input shaft member 101 is in turn transmitted tothe third driven gear 6-6 through the gear 6-2 and the secondintermediate gear 6-3 as well as the gear 6-5 and the third intermediategear 6-4, so that the third rotary member 110 is operated to rotateabout the sixth rotation axis 110 a. In this connection, means forfixing the gears to each other and means for fixing the gears to therotary members may be suitably selected from among various fixing means,such as bolts, keys, adhesives, etc., provided that the fixing means cantransmit the driving force between the mutually fixed components.

FIGS. 9A to 10 depict a major portion of the wrist-section drivemechanism 20. The wrist-section drive mechanism 20 is configured as adrive mechanism for controlling the orientation of the tool, such as thehand (FIGS. 7A and 7B), attached to the wrist section 102 and mounted onthe movable section 100. The parallel robot 10 according to anembodiment of the present invention is provided with three wrist-sectiondrive mechanisms 20 capable of operating independently of each other.The base section 12 is provided with three seat portions 56, each ofwhich is configured as depicted in FIG. 2, and which are formed atappropriate positions around the substantial center of the threeassembled-link structures 26. The outer holders 44 of the respectiveholder assemblies 50 are attached to the corresponding seat portions 56.As a result, the three wrist-section drive mechanisms 20 are arranged sothat the first rotation axes 44 a of the respective holder assemblies 50are parallel to each other.

Each wrist-section drive mechanism 20 includes a holder assembly 50configured by assembling three hollow cylindrical holders 44, 46 and 48in a manner rotatable with respect to each other to form a triply nestedstructure, a servo-motor 52 driving an outer holder 44 of the holderassembly 50 for rotation, and a rod-shaped transmission member 54linearly movably received in an inner holder 48 of the holder assembly50.

The outer holder 44 of the holder assembly 50 is attached to the seatportion 56 through a rotational bearing unit 58. In the illustratedembodiment, the inner ring of the rotational bearing unit 58 is fixed toone axial-end region (a bottom-end region, in the drawing) of the outercircumferential surface of the outer holder 44, the outer ring of therotational bearing unit 58 is fixed to the inner circumferential surfaceof a hollow cylindrical attachment member 60, and the attachment member60 is fixed to one axial end (a top end, in the drawing) of the seatportion 56 (FIG. 10). In this state, the outer holder 44 is connected tothe base section 12 and rotatable about a first rotation axis 44 aextending vertically with respect to the base section 12 (i.e., withrespect to the mounting surface for the parallel robot 10) with theinternal space of the outer holder 44 being coaxially and juncturallyarranged with respect to the internal space of the seat portion 56. Inthe illustrated embodiment, the first rotation axis 44 a coincides witha geometrical center line of the cylindrical outer holder 44. The outerring of the rotational bearing unit 58 may be directly fixed to the seatportion 56 without using the attachment member 60.

As depicted in FIG. 9A, the intermediate holder 46 of the holderassembly 50 is provided with an outer circumferential surface having adiameter smaller than the diameter of the inner circumferential surfaceof the outer holder 44 and a pair of spindles 62 projecting axiallyoutward and formed at predetermined mutually-opposite positions spacedfrom each other by a central angle of 180 degrees on the outercircumferential surface of the intermediate holder 46. The spindles 62are disposed so that the geometrical center lines thereof coincide witheach other and extend orthogonally to the geometrical center line of theintermediate holder 46. On the other hand, the outer holder 44 isprovided with a pair of spindle holes 64 penetrating radiallytherethrough and formed at predetermined mutually-opposite positionsspaced from each other by a central angle of 180 degrees on the innercircumferential surface of the outer holder 44. The spindle holes 64 aredisposed so that the geometrical center lines thereof coincide with eachother and extend orthogonally to the geometrical center line of theouter holder 44.

The intermediate holder 46 is attached to the outer holder 44 through apair of rotational bearing units 66 respectively provided in the spindleholes 64, with the spindles 62 of the intermediate holder 46 beingrespectively inserted into the corresponding spindle holes 64 of theouter holder 44. More specifically, the inner ring of each rotationalbearing unit 66 is fixed to the outer circumferential surface of eachspindle 62 of the intermediate holder 46, and the outer ring of eachrotational bearing unit 66 is fixed to the inner circumferential surfaceof each spindle hole 64 of the outer holder 44. In this state, theintermediate holder 46 is provided inside the outer holder 44 androtatable about a second rotation axis 46 a orthogonal to both thegeometrical center line of the intermediate holder 46 and the firstrotation axis 44 a.

As depicted in FIG. 9B, the inner holder 48 of the holder assembly 50 isprovided with an outer circumferential surface having a diameter smallerthan the diameter of the inner circumferential surface of theintermediate holder 46 and a pair of spindles 68 projecting radiallyoutward and formed at predetermined mutually-opposite positions spacedfrom each other by a central angle of 180 degrees on the outercircumferential surface of the inner holder 48. The spindles 68 aredisposed so that the geometrical center lines thereof coincide with eachother and extend orthogonally to the geometrical center line of theinner holder 48. On the other hand, the intermediate holder 46 isprovided with a pair of spindle holes 70 penetrating radiallytherethrough and formed at predetermined mutually-opposite positionsspaced from each other by a central angle of 180 degrees and also spacedfrom the pair of spindles 62 by a central angle of 90 degrees. Thespindle holes 70 are disposed so that the geometrical center linesthereof coincide with each other and extend orthogonally to thegeometrical center line of the intermediate holder 46.

The inner holder 48 is attached to the intermediate holder 46 through apair of rotational bearing units 72 respectively provided in the spindleholes 70, with the spindles 68 of the inner holder 48 being respectivelyinserted into the corresponding spindle holes 70 of the intermediateholder 46. More specifically, the inner ring of each rotational bearingunit 72 is fixed to the outer circumferential surface of each spindle 68of the inner holder 48, and the outer ring of each rotational bearingunit 72 is fixed to the inner circumferential surface of each spindlehole 70 of the intermediate holder 46. In this state, the inner holder48 is provided inside the intermediate holder 46 and rotatable about athird rotation axis 48 a orthogonal to both the geometrical center lineof the inner holder 48 and the second rotation axis 46 a.

A gear 74 as a power transmission element is fixed to the other axialend (a top end, in the drawing) of the outer circumferential surface ofthe outer holder 44. An output shaft 76 of the servo-motor 52 is meshedwith the gear 74 (FIG. 10). The servo-motor 52 drives the outer holder44 through the gear 74 so as to rotate about the first rotation axis 44a. Alternatively, in place of the gear 74, a belt and a pulley may beused as the power transmission element.

The transmission member 54 is a monolithic or single-piece rod-shapedelement provided with an outer circumferential surface having a diametersmaller than the diameter of the inner circumferential surface of theinner holder 48 of the holder assembly 50, and is attached to the innerholder 48 through a linear bearing member 78 provided inside the innerholder 48. In this state, the transmission member 54 is received in theinner holder 48 and linearly movable over the entire length of thetransmission member 54 in a rotationally restrained state, along alinear-motion axis 54 a parallel to the geometrical center lines of boththe transmission member 54 and the inner holder 48 and orthogonal to thethird rotation axis 48 a. In the illustrated embodiment, thelinear-motion axis 54 a coincides with the geometrical center lines ofboth the transmission member 54 and the inner holder 48.

In order to improve accuracy in tool orientation control, it isnecessary that the linear bearing member 78 guiding the transmissionmember 54 in a rotationally restrained state can transmit the outputpower of the servo-motor 52 to the transmission member 54 whileeliminating loss of power as much as possible. From this viewpoint, aspline nut of a ball spline unit can be preferably used as the linearbearing member 78. In this case, the transmission member 54 has aconfiguration of a spline shaft of the ball spline unit. The ball splineunit is known in the art and thus is not described herein in detail.

The holder assembly 50 acts as a universal joint arranged between thetransmission member 54 and the base section 12 or the output shaft 76 ofthe servo-motor 52 and having a special configuration capable ofperforming a relative motion along the geometrical center line (or thelinear-motion axis 54 a) of the transmission member 54. Morespecifically, the outer holder 44 is a driving-side component of thespecial universal joint and the inner holder 48 is a driven-sidecomponent of the special universal joint. Therefore, in either apositional relationship wherein the linear-motion axis 54 a is parallelto the first rotation axis 44 a of the outer holder 44 or a positionalrelationship wherein the linear-motion axis 54 a is oblique to the firstrotation axis 44 a, the transmission member 54 can rotate together orintegrally with the inner holder 48 about the linear-motion axis 54 a insynchronization with the rotation of the outer holder 44 driven by theprime mover 52.

In the holder assembly 50, the allowable inclination angle of thetransmission member 54 with respect to the outer holder 44 (i.e., of thelinear-motion axis 54 a with respect to the first rotation axis 44 a) isdetermined by the relative positional and dimensional relationship amongthe outer holder 44, the intermediate holder 46 and the inner holder 48.In the typical work of the parallel robot 10 (e.g., a handling work), itis desirable that the transmission member 54 can be inclined in therange of about 0 to 40 degrees. As depicted in the drawings, the holderassembly 50 configured by assembling three hollow cylindrical holders44, 46, 48 to form a triply nested structure can be constructed in sucha manner that the intermediate holder 46 and the inner holder 48 do notsubstantially protrude outward from the outer holder 44. Therefore, itis possible to easily reduce the overall dimensions of the holderassembly 50 without impairing the required ability of the universaljoint.

As described with reference to FIG. 3, the transmission member 54 (54-1,54-2, 54-3) is swingably connected, at one end (a bottom end, in thedrawing) spaced from the inner holder 48 of the holder assembly 50, tothe wrist section 102 through a universal joint 80 (80-1, 80-2 and 80-3)having a typical structure. In this configuration, the transmissionmember 54 operates to smoothly transmit the rotation of the outer holder44 about the first rotation axis 44 a of the holder assembly 50 to thewrist section 102, and to allow the first rotary member 106 of the wristsection 102 about the fourth rotation axis 106 a orthogonal to the thirdrotation axis 48 a of the holder assembly 50.

In particular, in the parallel robot 10, the transmission member 54 cansmoothly follow the three-axis translational motion of the movablesection 100 and the wrist section 102 obtained by the movable-sectiondrive mechanism 16 having the parallel mechanism configuration, and thuscan passively move along the linear-motion axis 54 a with respect to theholder assembly 50 as a universal joint arranged between thetransmission member 54 and the base section 12 or the prime-mover outputshaft 76. As a result, when the movable section 100 and the wristsection 102 are located at a desired (or commanded) spatial positionwithin the operational space thereof, the torque of the servo-motor 52can be reliably transmitted to the wrist section 102.

In this connection, as described above, the movable-section drivemechanism 16 drives the movable section 100 so that the movable section100 performs only the three-axis translational motion with respect tothe base section 12. Therefore, during the operation of themovable-section drive mechanism 16, the fourth rotation axis 106 a ofthe wrist section 102 is always disposed parallel to the first rotationaxis 44 a of the holder assembly 50. As a result, the angular velocityof the outer holder 44 corresponds to the angular velocity of the inputshaft member 101 of the wrist section 102, regardless of the inclinationangle of the transmission member 54 with respect to the base section 12.

In the configuration described above, when the transmission member 54follows the three-axis translational motion of the movable section 100and the wrist section 102, the transmission member 54 tends to protrudeupward from the outer holder 44 of the holder assembly 50 carried on thebase section 12 in various angles and by various lengths. Therefore, inorder to avoid interference between the servo-motor 52 and thetransmission member 54, it is advantageous that the servo-motor 52 ofthe wrist-section drive mechanism 20 is carried on the base section 12at a position adjacent to the outer holder 44 so as not to protrudebeyond the outer holder 44 in a direction (an upward direction, in thedrawing) away from the movable section 100 (see FIG. 10).

As apparent from the above description, the parallel robot 10 accordingto the illustrated embodiment has a configuration in which the number ofdegrees of freedom regarding the orientation change axes of the wristsection 102 is increased to three degrees, so that various tasks, suchas a task for mounting a workpiece to an inclined surface, can beperformed. Further, the parallel robot 10 can prevent the occurrence ofa singular state (or a singularity) where a robot movement for disposinga tool mounted on the wrist section 102 (or the movable section 100) ata target position and orientation cannot be unambiguously programmed ordetermined, even when the attachment surface 114 of the wrist section102 is disposed at a relatively frequently-taken orientation (in a casewhere the parallel robot 10 is situated on the floor, the orientation inwhich the attachment surface 114 is horizontal with respect to a floorsurface).

FIG. 12 schematically depicts a parallel robot according to anembodiment of the present invention. The illustrated parallel robot hasa configuration substantially identical to that of the parallel robot PRor 10 depicted in FIGS. 1 to 11. However, in FIG. 12, wall 22, cover 24and movable-section drive mechanism 16 (FIG. 1 or 6) are not depicted,and base section 12 is depicted by a broken line.

The illustrated parallel robot includes a base section 12; a movablesection 100 capable of moving with respect to the base section 12; amovable-section drive mechanism 16 having a parallel mechanismconfiguration and provided between the base section 12 and the movablesection 100, the movable-section drive mechanism 16 operating to allowthe movable section 100 to perform a three-axis translational motionwith respect to the base section 12; a wrist section 102′ or 102provided in the movable section 100 in a manner capable of changing anorientation of the wrist section 102′ or 102; and a wrist-section drivemechanism 20 operating to allow the wrist section 102′ or 102 to performa three-axis orientation-changing motion with respect to the movablesection 100. The wrist section 102′ or 102 includes a first rotarymember 106 supported on the movable section 100 and rotatable about afourth rotation axis 106 a different from axes of the three-axistranslational motion of the movable section 100; a second rotary member108 connected to the first rotary member and rotatable about a fifthrotation axis 108 a orthogonal to the fourth rotation axis 106 a; athird rotary member 110 connected to the second rotary member 108 androtatable about a sixth rotation axis 110 a orthogonal to the fifthrotation axis 108 a; and a first input shaft member 101, a second inputshaft member 101 and a third input shaft member 101, rotatably supportedon the movable section 100 and connected respectively to the firstrotary member 106, the second rotary member 108 and the third rotarymember 110 through gears (see FIG. 8B). The wrist-section drivemechanism 20 includes a first servo-motor 52, a second servo-motor 52and a third servo-motor 52, which are carried on the base section 12(see FIG. 10) and respectively generate driving force to drive the wristsection 102′ or 102 for rotation; and a first transmission member 54-1,a second transmission member 54-2 and a third transmission member 54-3,transmitting the driving force of the first servo-motor 52, the secondservo-motor 52 and the third servo-motor 52, respectively to the firstinput shaft member 101, the second input shaft member 101 and the thirdinput shaft member 101. The first servo-motor 52, the second servo-motor52 and the third servo-motor 52 respectively drive the first rotarymember 106, the second rotary member 108 and the third rotary member 110for rotation.

While the invention has been described with reference to specificpreferred embodiments, it will be understood, by those skilled in theart, that various changes or modifications may be made thereto withoutdeparting from the scope of the following claims.

1. A parallel robot comprising: a base section; a movable section capable of moving with respect to said base section; a movable-section drive mechanism having a parallel mechanism configuration and provided between said base section and said movable section, said movable-section drive mechanism operating to allow said movable section to perform a three-axis translational motion with respect to said base section; a wrist section provided in said movable section in a manner capable of changing an orientation of the wrist section; and a wrist-section drive mechanism operating to allow said wrist section to perform a three-axis orientation-changing motion with respect to said movable section, wherein said wrist section comprises: a first rotary member supported on said movable section and rotatable about a fourth rotation axis different from axes of said three-axis translational motion of said movable section; a second rotary member connected to said first rotary member and rotatable about a fifth rotation axis orthogonal to said fourth rotation axis; a third rotary member connected to said second rotary member and rotatable about a sixth rotation axis orthogonal to said fifth rotation axis; and a first input shaft member, a second input shaft member and a third input shaft member, rotatably supported on said movable section and connected respectively to said first rotary member, said second rotary member and said third rotary member through gears; wherein said wrist-section drive mechanism comprises: a first servo-motor, a second servo-motor and a third servo-motor, which are carried on said base section and respectively generate driving force to drive said wrist section for rotation; and a first transmission member, a second transmission member and a third transmission member, transmitting the driving force of said first servo-motor, said second servo-motor and said third servo-motor, respectively to said first input shaft member, said second input shaft member and said third input shaft member; said first servo-motor, said second servo-motor and said third servo-motor respectively driving said first rotary member, said second rotary member and said third rotary member for rotation. 